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^^P^^SililS^^ PROBLEM TO BE SOLVED: To detect the 

presence of an obstacle on a pavement along 
with rough distance and direction thereof by 
scanning the pavement one-dimensionally with 
laser light, or the like, and detecting variation in 
the amplitude of irregularities on the pavement 
caused by the presence of an obstacle. 
SOLUTION: A distance comparison data 
group E of measuring points within a specified 
pavement width in the expected traveling 
direction is extracted along with a pavement 
reference data group Co of measuring points 
in the vicinity thereof from a distance data population A. data operation is repeated 
up to n-th step based on a distance data C1 extracted from a data population CO 
and a pavement reference line BLkj is calculated at each step thus deriving a final 
pavement reference line BLk,n. Each distance data at all measuring points in the 
data group E is then compared, at the comparing section of an operating unit, with 
the distance value on the reference line BLk,n corresponding to each measuring 
point thus determining the presence of an obstacle. 
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CLAIMS 



[Claim(s)] 

[Claim 1] A single dimension is made to scan the distance measuring equipment 
installed on the car it runs, A statistics processing-operation extracts a part or all 
distance data from the distance data population A of all the measure points for 
every one scan in the datum-line calculation section of an arithmetic unit, and he is 
the road surface datum-line data ensemble C1. It extracts, Using said extracted 
distance data, based on predetermined operation expression, the data operation of 
the 1st step is performed and it is road surface datum-line BLK.1. It determines in 
the datum-line calculation section, road surface datum-line BLK.j-1 of the j-1st 
steps corresponding to the part or all the distance data, and each measure point of 
those of said distance data population A - comparing the upper (number of steps 
from j:2 to n) distance value -- new - distance data ensemble Cj It extracts. 
Furthermore, it is based on the distance data ensemble's Cj (number of steps from 
j:2 to n) newly extracted distance data, and is road surface datum-line BLK.j of the 
j-th step. It computes, This is repeated to the n-th step and it is final road surface 
datum-line BLK.n. It determines in the datum-line calculation section, And route 
datum-line BLK.n corresponding to the part or all the distance data, and each 
measure point of those of said distance data population A at the comparator of an 
arithmetic unit Compare the upper distance value and an obstruction transit on the 
street is detected. The detection approach of the obstruction transit on the street 
characterized by including shifting to the scan on and after next time furthermore. 
[Claim 2] All in the predetermined road width of the transit schedule direction or 
some distance data are extracted from said distance data population A, and it 
considers as the distance comparison data ensemble E, All near [ predetermined ] 
the road width of the transit schedule direction or some distance data are extracted 
from said distance data population A, and he is the road surface datum-line data 
ensemble CO. By carrying out and the operation for every step instead of [ of said 
distance data population A ] - said road surface datum-line data ensemble CO 
from - distance data ensemble Cj who extracted from - road surface datum-line 
BLK.j determining in the datum-line calculation section of an arithmetic unit - Said 



last road surface datum-line BLK.n corresponding to all the distance data and each 
measure point which belong to said distance comparison data ensemble E in case 
the comparator of an arithmetic unit compares The detection approach of an 
obstruction including comparing the upper distance value according to claim 1. 
[Claim 3] About the value compared by the comparator of said arithmetic unit, they 
are the distance data of each measure point, and said last road surface datum-line 
BLK.n. About a difference with the distance value to which it corresponds [ upper ], 
it is the road surface datum-line BLK.n. The detection approach of the obstruction 
according to claim 1 or 2 made into the rate of deflection which **(ed) with the 
distance value to which it corresponds [ upper ]. 

[Claim 4] The extract of said distance data ensemble Cj (number of steps of the 
arbitration from j:1 to n) in the j-th step It is based on the standard road surface 
datum line latest starting time set as the beginning of each scan, and they are said 
distance data population A or the road surface datum-line data ensemble CO. It 
asks for the deflection or the rate of deflection with a corresponding distance value 
on the distance data of each measure point, and said standard road surface datum 
line latest starting time. The detection approach of the obstruction according to 
claim 2 or 3 performed by extracting the distance data in the threshold. 
[Claim 5] An extract of said distance data ensemble Cj (number of steps of the 
arbitration from j:1 to n) who can set at the j-th step Road surface datum-line 
BLK.j-s obtained by the data operation before s step It is based. Said distance data 
population A or road surface datum-line data ensemble CO Distance data and said 
road surface datum-line BLK.j-s of each measure point It asks for the upper 
deflection or the upper rate of deflection with a corresponding distance value. The 
detection approach of the obstruction according to claim 2 or 3 performed by 
extracting the distance data in the threshold. 

[Claim 6] The extract of said distance data ensemble Cj (number of steps of the 
arbitration from j:1 to n) in the j-th step Road surface datum-line BLK-q.n computed 
from the scan q times ago (it contains also last time) It is based. Said distance data 
population A or road surface datum-line data ensemble CO Distance data and said 
road surface datum-line BLK-q.n of each measure point It asks for the upper 
deflection or the upper rate of deflection with a corresponding distance value. The 
detection approach of the obstruction according to claim 2 or 3 performed by 



extracting the distance data in the threshold. 

[Claim 7] The extract of said distance data ensemble Cj (number of steps of the 
arbitration from j:1 to n) in the j-th step Road surface datum-line BLK-q.n computed 
by the scan q times ago (it contains also last time) It is based on the deflection or 
the rate of deflection computed from the distance data obtained by the scan q times 
ago. Said distance data population A by the scan of this time (the Kth time) in the 
threshold, or road surface datum-line data ensemble CO The detection approach of 
the obstruction according to claim 2 or 3 performed by extracting the distance data 
corresponding to each measure point 

[Claim 8] The detection approach of an obstruction according to claim 6 or 7 of 
dividing into two or more fields the range scanned by said single dimension, and 
changing the value of the threshold of the data extraction in each field. 
[Claim 9] The detection approach of an obstruction transit on the street that the 
combination of the extract approach according to claim 4 to 7 extracts said distance 
data ensemble Cj (number of steps of the arbitration from j:1 to n) in the j-th step. 
[Claim 10] Road surface datum-line BLK.j which asks for said road surface 
datum-line BLK.j (number of steps of the arbitration from j:1 to n) in the j-th step 
with the distance data for every measure point Deflection di The detection 
approach of an obstruction according to claim 1 to 3 of computing and determining 
that the total of the m-th power of an absolute value will consider as min. 
[Claim 11] The detection approach of the obstruction according to claim 1 to 3 
determined by computing as a line by which it was not concerned with the location 
of a measure point, but only the constant rate offset said road surface datum-line 
BLK.j (number of steps of the arbitration from j:1 to n) in the j-th step from said 
standard road surface datum line latest starting time. 

[Claim 12] The detection approach of the obstruction according to claim 1 to 3 
determined by computing said road surface datum-line BLK.j (number of steps of 
the arbitration from j:1 to n) in the j-th step as a line which has the predetermined 
amount of offset, offsets and is obtained from said standard road surface datum 
line latest starting time for every measure point. 

[Claim 13] said road surface datum-line BLK-q.n which was not concerned with the 
location of a measure point but was computed by the scan q times ago (it contains 
also last time) in said road surface datum-line BLK.j (number of steps of the 



arbitration from j:1 to n) in the j-th step from - the detection approach of the 
obstruction according to claim 1 to 3 which boils computing as a line which offset 
only the constant rate, and is determined more. 

[Claim 14] said road surface datum-line BLK-q.n computed by the scan q times ago 
(it contains also last time) for every measure point in said road surface datum-line 
BLK.j (number of steps of the arbitration from j:1 to n) in the j-th step from - the 
detection approach of the obstruction according to claim 1 to 3 computed as a line 
offset and obtained with the predetermined amount of offset. 
[Claim 15] The detection approach of an obstruction according to claim 1 to 3 that 
said road surface datum-line BLK.j (number of steps of the arbitration from j:1 to n) 
in the j-th step is the straight line drawn from the height of distance measuring 
equipment by the pitch angle of distance measuring equipment and/or a roll angle, 
and the list based on a geometric constraint. 

[Claim 16] It is made to scan respectively in single dimension with the inclination 
from which an obstruction is a mobile, and a car comes to have said 1st and 2nd 
distance measuring equipment, and differs each distance measuring equipment, If 
existence of the distance data besides a threshold is checked by some distance 
data by said comparator circuit at the time of the scan of each 1st and 2nd distance 
measuring equipment The detection approach of the obstruction according to claim 
1 which comes to contain detecting the passing speed and the migration direction 
of a mobile from the detection time difference between the scan point of each of 
that corresponding distance data, and this point. 

[Claim 17] A single dimension is made to scan the distance measuring equipment 
installed on the car it runs, the distance data population A of all the measure points 
for every one scan, or road surface datum-line data ensemble CO in the road width 
of them from - computing the road surface datum line in step j-1 by the statistics 
processing-operation using the data ensemble who extracted ~ Distance data 
ensemble Cj in step j Before extracting, existence of an obstruction is presumed, 
and in a "nothing" case, it is Cj. Extract processing is omitted, and it shifts to the 
next scan, and, in the case of a "****", is Cj. The existence-or-nonexistence 
presumption approach of the obstruction transit on the street characterized by 
making extract processing. 



DETAILED DESCRIPTION 



[Detailed Description of the Invention] 
[0001] 

[Field of the Invention] This invention relates to the method of detecting various 
kinds of obstructions which exist in the transit on the street by cars, such as a 
mobile robot and an autonomous transit car, for example, a rugged terrain form and 
rock, a fallen tree, the mobile coming flying, and the presumed approach of the 
existence or nonexistence. 
[0002] 

[Description of the Prior Art] In order for the above-mentioned car to autonomy-run 
or half-autonomous run, the irregularity of front geographical feature must be 
recognized. For that purpose, it is necessary to measure the distance, the height, 
and its direction of [ from a car to a rugged terrain form ]. What used the laser range 
finder and the stereoscopic camera as equipment for recognizing these terrestrial 
obstructions conventionally is known. Using these equipments, the conventional 
detection system measured the ground two-dimensional, created the detailed 
rugged terrain Fig. of geographical feature, and has detected the obstruction. 
[0003] The case where the laser range finder which two dimensions are made to 
scan a laser beam below, and detects the distance to an obstruction, height, and its 
range below at a precision is used is explained briefly. Drawing 14 shows the 
outline of the laser distance measuring equipment of a 2-dimensional scan type. 
According to this drawing, laser distance measuring equipment is equipment which 
measures the distance from time amount until the laser beam which carried out 
outgoing radiation towards the object reflects and returns to an object. At this time, 
by scanning the laser beam (transmitting light) emitted from the laser oscillation 
machine 100 to two dimensions using a rotating polygon 101 and a galvanomirror 
102, distance data are detected one after another and the distance to each point in 
sensing area is measured. 

[0004] When it is going to perform this measurement from on a car, a laser beam is 
scanned to two dimensions, sensing is repeated over the whole area a car tends to 
run, the exact map (altitude map) in which the irregularity (altitude) of geographical 
feature was described is created from the distance data and bearing of each point, 



the field (obstruction field) which cannot run a car is detected, and a transit path is 
planned. 

[0005] In order to create said altitude map generally, it is made by computing the 
coordinate (location: X, Y, Z) of each measure point in drawing 15 from the 
geometric constraint (Inclination th, the vectorial angle alp and height Hs of a 
measuring device to a measure point, measurement distance L) of laser distance 
measuring equipment and a measure point. At this time, the coordinate location (X, 
Y, Z) of each measure point receives pitching of a car, and the effect of rolling. As a 
cure for not receiving the effect, stop ** car or make it super-low **. ** Carry out 
sensing of pitching of a car body, and the rolling by a tilt-angle sensor etc. Stabilize 
to space ** sensor which carries out coordinate transformation of the location data 
using a gimbal etc. ** Installing a sensor in the center of ** wheel base which 
makes large ** tread (wheel track) which enlarges a wheel radius, and which 
lengthens ** wheel base (distance between axles), and a tread etc. needs to be 
considered. 
[0006] 

[Problem(s) to be Solved by the Invention] However, since the acquisition time 
amount and analysis time amount became long in these detection systems since 
the number of data increases extremely, and it was further influenced [ rolling of a 
car, and ] of pitching in measurement, it was difficult [ it ] to detect an obstruction 
with high precision, running, after [ consequently, ] detecting ah obstruction, making 
it run a car by a stop or super-low ** - usually - transit - not resuming - it was 
impossible to have not obtained but to have taken quick action. 
[0007] Therefore, the purpose of this invention performs reliable data processing, 
and is to offer the detection approach of the obstruction which made it possible to 
detect certainly the obstruction which exists in a transit on the street, or comes 
flying a transit on the street during the usual transit, and its 
existence-or-nonexistence presumption approach while it is lessening the amount 
of data and shortens a question sharply at the time of data-acquisition time amount 
and analysis, without creating a highly precise advanced map. 
[0008] 

[Means for Solving the Problem and its Function and Effect] This invention detects 
the existence or nonexistence of the obstruction transit on the street through which 



a car cannot pass for every one scan, not creating a highly precise altitude map but 
scanning a laser beam or a supersonic wave, and a millimeter wave on a road 
surface at a single dimension without scanning to two dimensions like the former. 
That is, if this obstruction exists, paying attention to the amplitude of the irregularity 
of the road surface in the area becoming larger than the amplitude of other area, it 
will have change of the amplitude and the existence of an obstruction and a rough 
distance, and a direction will be detected. According to invention concerning these 
claims 1-17, it has the following configurations and the above-mentioned purpose is 
attained. 

[0009] Invention concerning claim 1 makes a single dimension scan the distance 
measuring equipment installed on the car it runs, A statistics processing-operation 
extracts a part or all distance data from the distance data population A of all the 
measure points for every one scan in the datum-line calculation section of an 
arithmetic unit, and he is the road surface datum-line data ensemble C1 . It extracts, 
Using said extracted distance data, based on predetermined operation expression, 
the data operation of the 1st step is performed and it is road surface datum-line 
BLK.1. It determines in the datum-line calculation section, road surface datum-line 
BLK.j-1 of the j-1st steps corresponding to the part or all the distance data, and 
each measure point of those of said distance data population A - comparing the 
upper (number of steps of until [ from j:2 ]) distance value - new - distance data 
ensemble Cj It extracts. Furthermore, it is based on the distance data ensemble's 
Cj (number of steps from j:2 to n) newly extracted distance data, and is road 
surface datum-line BLK.j of the j-th step. It computes in the datum-line calculation 
section, This is repeated to the n-th step and it is final road surface datum-line 
BLK.n. It determines in the datum-line calculation section, And route datum-line 
BLK.n corresponding to the part or all the distance data, and each measure point of 
those of said distance data population A at the comparator of an arithmetic unit The 
upper distance value is compared, an obstruction transit on the street is detected, 
and it shifts to the scan on and after next time. The value of immobilization is 
sufficient as the threshold of the comparative judgment for obstruction detection 
here, or when the value needs to be amended, it can also be suitably amended so 
that it may mention later. 

[0010] That is, the datum line of a reliable road surface is set up based on the 



distance data obtained for every scan, repeating the scan of multiple times in single 
dimension from the car it runs. In a setup of this road surface datum line as the 1st 
step for every scan Desired data are extracted [ from ] among said distance data 
obtained by scan, and he is the road surface datum-line data ensemble C1. It 
carries out. This extracted distance data ensemble C1 Based on distance data, the 
road surface datum line of the 1st step is computed. The distance data of the 
distance data population A are compared with the distance value corresponding to 
the measure point on the road surface datum line which the 1st step computed as 
the 2nd step. The distance data with which that compound value goes into the 
range of a threshold are anew extracted from all or the necessary scanning zone of 
the distance data population A, and he is the distance data ensemble C2. It carries 
out and he is this extracted distance data ensemble C2. Based on distance data, 
the road surface datum line of the 2nd step is computed. Such actuation is 
repeated to the n-th step, and it is final road surface datum-line BLK.n. It draws. 
Number-of-steps n at this time is suitably determined in consideration of a 
surrounding situation. 

[0011] Invention concerning claim 1 has invention concerning claim 2, all in the 
predetermined road width of the transit schedule direction or some distance data 
are extracted from said distance data population A, and it considers as the distance 
comparison data ensemble E, All near [ predetermined ] the road width of the 
transit schedule direction or some distance data are extracted from said distance 
data population A, and he is the road surface datum-line data ensemble CO. By 
carrying out and the operation for every step instead of [ of said distance data 
population A ] - said road surface datum-line data ensemble CO from - road 
surface datum-line BLK[ from the distance data ensemble Cj (number of steps from 
j:1 to n) who extracted ] .j determining with an arithmetic unit - Said last road 
surface datum-line BLK.n corresponding to the distance data which belongs to said 
distance comparison data ensemble E in case it compares in a comparator circuit, 
and its measure point It includes comparing the upper distance value by the 
comparator of an arithmetic unit. 

[0012] According to this invention, besides the road surface datum-line data 
ensemble Cj (number of steps from j:1 to n) in claim 1 Extract all the distance data 
in the predetermined road width of the transit schedule direction, and it considers 



as the distance comparison data ensemble E. All or some distance data near 
[ predetermined ] the road width of the transit schedule direction are extracted, and 
he is the road surface datum-line data ensemble CO. It carries out. Said road 
surface datum-line data ensemble CO It treats as the population of the distance 
data when extracting the road surface datum-line data ensemble Cj (number of 
steps from j:1 to n). It is considering as measurement data in case the comparator 
of the above-mentioned arithmetic unit compares all said distance comparison data 
ensemble's E distance data. This is for securing the dependability of a compound 
value, and uses invention and this invention of claim 1 properly according to a 
circumference situation. 

[0013] Invention concerning claim 3 is the distance data of each measure point i, 
and said road surface datum-line BLK.n about the value compared by the 
comparator of said arithmetic unit. About a difference with the distance value to 
which it corresponds [ upper ], it is the road surface datum-line BLK.n. It considers 
as the rate of deflection which **(ed) with the distance value to which it corresponds 
[ upper ], and a reliable detection result is obtained. 

[0014] Invention concerning claim 4 - claim 7 is in charge of the extract of said 
distance data for every step. If it is in invention which has specified the extract 
technique of the various distance data for deriving a road surface datum line, and 
relates to claim 4 The extract of said distance data ensemble Cj (number of steps of 
the arbitration from j:1 to n) in the j-th step It is based on the standard road surface 
datum line latest starting time set as the beginning of each scan, and they are said 
distance data population A or the road surface datum-line data ensemble CO. It 
asks for the deflection or the rate of deflection with a corresponding distance value 
on the distance data of each measure point, and said standard road surface datum 
line latest starting time. It carries out by extracting the distance data in the threshold. 
[0015] Invention concerning claim 5 the extract of said distance data set Cj (number 
of steps of the arbitration from j:1 to n) in the j-th step Road surface datum-line 
BLK.j-s obtained by the data operation before s step It is based. Said distance data 
population A or road surface datum-line data ensemble CO Distance data and said 
road surface datum-line BLK.j-s of each measure point It asks for the upper 
deflection or the upper rate of deflection with a corresponding distance value, and 
carries out by extracting the distance data in the threshold. 



[0016] Invention concerning claim 6 the extract of said distance data ensemble Cj 
(number of steps of the arbitration from j:1 to n) in the j-th step Road surface 
datum-line BLK-q.n computed from the scan q times ago (it contains also last time) 
It is based. Said distance data population A or road surface datum-line data 
ensemble CO It asks for the deflection or the rate of deflection with a corresponding 
distance value on the distance data of each measure point, and said road surface 
datum-line BLK-q.n, and carries out by extracting the distance data in the threshold. 
[0017] Invention concerning claim 7 the extract of said distance data ensemble Cj 
(number of steps of the arbitration from j:1 to n) in the j-th step Road surface 
datum-line BLK-q.n computed by the scan q times ago (it contains also last time) It 
is based on the deflection or the rate of deflection computed from the distance data 
obtained by the scan q times ago. It carries out by extracting the distance data 
corresponding to each measure point of said distance data population A by the 
scan of this time (the Kth time) in the threshold, or the distance comparison data 
ensemble E. 

[0018] It has specified invention concerning said claim 6 or 7 having invention 
concerning claim 8, it dividing into two or more fields the range scanned by said 
single dimension, changing the value of the threshold in each field, and setting it up. 
And it has specified that said distance data ensemble Cj (number of steps of the 
arbitration from j:1 to n) can be extracted with the combination of the extract 
approach according to claim 4 to 7 like invention concerning claim 9. 
[0019] If claim 10 - claim 15 are in invention which has specified the calculation 
technique of the above-mentioned road surface datum-line BLK.j (number of steps 
of the arbitration from j:1 to n), and relates to claim 10 Said road surface datum-line 
BLK.j (number of steps of the arbitration from j:1 to n) in the j-th step The distance 
data for every measure point, and road surface datum-line BLK.j for which it asks 
Deflection di It carries out by computing so that total of the m-th power of an 
absolute value may be made into min. If it is in invention concerning claim 11, it is 
computing as a line which was not concerned with the location of a measure point 
but offset only the constant rate from said standard road surface datum line latest 
starting time. 

[0020] Moreover, invention concerning claim 12 computes said road surface 
datum-line BLK.j (number of steps of the arbitration from j:1 to n) in the j-th step as 



a line which has the predetermined amount of offset, offsets and is obtained from 
said standard road surface datum line latest starting time for every measure point. 
[0021] Invention concerning claim 13 and claim 14 said road surface datum-line 
BLK.j (number of steps of the arbitration from j:1 to n) said road surface datum-line 
BLK-q.n which was not concerned with the location of a measure point but was 
computed by the scan q times ago (it contains also last time) from - whether it 
computes as a line which offset only the constant rate or said road surface 
datum-line BLK-q.n computed by the scan q times ago (it contains also last time) 
for every measure point from - it has specified computing as a line offset with the 
predetermined amount of offset. 

[0022] Invention concerning claim 15 is replaced with measuring only the distance 
from the distance measuring equipment on a car to a measure point, as mentioned 
above. It is what is measured also in consideration of the height of distance 
measuring equipment in the pitch angle of distance measuring equipment and/or a 
roll angle, and a list. Said road surface datum-line BLK.j (number of steps of the 
arbitration from j:1 to n) has specified deriving from the height of distance 
measuring equipment as a straight line based on a geometric constraint in the pitch 
angle of distance measuring equipment and/or the roll angle, and the list. 
[0023] Although it is common that it is the obstruction which exists on the ground as 
for the above candidate for detection, invention concerning claim 16 mentions 
suitable technique to have specified that an obstruction may be a mobile and detect 
especially the near passing speed and near direction. Of course, it can be 
understood also by the same technique as above-mentioned invention that the 
migration and location can be detected. According to claim 16, it is in invention 
according to claim 1, the car has said 1st and 2nd distance measuring equipment, 
and each distance measuring equipment is made to scan respectively in single 
dimension with a different inclination, If existence of the distance data besides a 
threshold is checked by some distance data by said comparator circuit at the time 
of the scan of each 1st and 2nd distance measuring equipment, it includes 
detecting the passing speed and the migration direction of a mobile from the 
detection time difference between the scan point of each of that corresponding 
distance data, and this point. 

[0024] Invention concerning claim 17, without carrying out like **** by having 



number-of-steps n at every one scan, and repeating an extract and data operation 
of distance data For example, when the detection result it is supposed that an 
obstruction does not exist in the scan with the road surface datum line obtained by 
the extract and data operation of distance data of the 1st step eye comes out When 
the result in which it may shift to a next scan and an obstruction may exist by the 
detection result of the 1st step comes out without performing the extract and data 
operation of distance data by subsequent steps After performing the extract and 
data operation of distance data of the 2nd-n-th step and deciding the existence of 
an obstruction, the existence-or-nonexistence presumption approach of an 
obstruction which shifts to next scanning is specified. 

[0025] Namely, the thing made to scan the distance measuring equipment installed 
on the car it runs in single dimension, every one scan - the distance data 
population A of all measure points, or road surface datum-line data ensemble CO in 
a certain predetermined road width from - extracting the part extracted by the 
statistics processing-operation, or all distance data - Distance data ensemble Cj in 
step j It is Cj, when it presumes that there are not presuming existence of an 
obstruction and an obstruction before extracting. It is Cj when omitting extract 
processing and shifting to the next scan and owner ** are presumed. Extract 
processing is performed. 
[0026] 

[Embodiment of the Invention] Hereafter, the gestalt of suitable operation of this 
invention approach is explained concretely, referring to a drawing. Drawing 1 
shows the outline configuration of the distance measuring equipment using the 
laser beam in this example. According to this drawing, a single dimension is made 
to scan the laser beam from the laser oscillation machine 1 by the rotating polygon 
3 through a half mirror 2, the reflected light is reflected by said half mirror 2, and it 
detects, and it inputs into the arithmetic unit which does not illustrate the 
measurement data, various kinds of statistical procedures and 
comparison-operation processing are performed, and the obstruction which is in a 
transit on the street so that it may explain below is detected. In addition, with the 
scan said here, it does not restrict horizontally but the perpendicular direction or the 
case where receive horizontally and it scans with a necessary include angle is also 
included. 



[0027] Drawing 2 sketches the mode of the obstruction detection at the time of 
transit by the distance measuring equipment 11 installed in the car 10. In this 
drawing, a sign 12 is an obstruction in a transit on the street, and the condition of 
having detected said some of obstructions 12 existing in the location of measure 
point i in the middle of scanning the laser beam 13 from distance measuring 
equipment 1 1 on a sensing line is shown. Drawing 3 shows the fundamental flow of 
the detection approach of the obstruction by this invention, and drawing 4 shows 
the example of derivation of the road surface datum line at the time of the 
obstruction detection by the 1st example of this invention. 
[0028] the distance measuring equipment 11 installed on the car 10 it runs now as 
shown in drawing 2 is scanned to a single dimension - making » the distance data 
population A to the part or all the distance data ensembles C1 of all measure points 
for the one scan of every It extracts. An extract of this distance data ensemble C1 is 
measurement distance value LK.i [ in / as shown in drawing 4 / measure point i of 
said distance data population A ]. Deflection (latest-starting-time.i-LK.i) with 
distance value latest-starting-time.i corresponding to the measure point on the 
standard road surface datum line latest starting time first set up for every scan is 
computed, and it carries out by extracting the distance data which are within the 
limits of the up-and-down thresholds THL1 and THH1. At this time, it is said each 
measurement distance value LK.i. It can replace with deflection with distance value 
latest-starting-time.i, and the rate of deflection by the degree type can also extract. 
In addition, a setup of said standard road surface datum line latest starting time is 
road surface datum-line BLK-1.n finally called for by the last scan with the 
intersection of the road surface and transit side which were assumed to be flat as 
shown in drawing 6 , i.e., the scanning line which can be simply found based on a 
geometric constraint, and various technique which is mentioned later. It uses as it is 
and is made, in addition, a geometric constraint (airraid pitch angle theta, roll angle 
phi, and height HS) - under transit -- each time -- measuring - a case -- it is - 
obtaining . 

THL2 <= (latest-starting-time.i-LK.i) / latest-starting-time.i<=THH2 - here, THL2 is 
a bottom threshold and THH2 is a top threshold. 

[0029] thus, obtained distance data set C1 Each measurement distance value LK.i 
which belongs the curve which makes min total of the square of the absolute value 



of deflection with a curve — asking - this curve - road surface datum-line BLK.1 of 
the 1st step ** -- it carries out. 

[0030] Next, this road surface datum-line BLK.1 It uses replacing with the 
above-mentioned standard road surface datum line latest starting time. 
Measurement distance value LK.i [ in / similarly / according to the above-mentioned 
procedure / measure point i ] Said road surface datum-line BLK.1 Distance value 
BLK.1. i corresponding to upper measure point i It asks for deflection or the rate of 
deflection, and he is the distance data ensemble C2 from the distance data 
ensemble A. It extracts. Road surface datum-line BLK.2 of the 2nd step It asks. 
This math operation is repeated several times (n times), and it is final road surface 
datum-line BLK.n of the n-th step. It asks. Road surface datum-line BLK.2 [ final at 
the 2nd step in this example ] It has determined. 

[0031] these road surface datum-line BLK.2 Each measurement distance value 
LK.i in each measure point i which belongs to the above-mentioned distance data 
population A after asking Said distance datum-line BLK.2 Distance value BLK.2. i 
corresponding to upper measure point i Ask for the rate of deflection and it is 
judged to have no obstruction, when it compares in a comparator circuit and is in 
the range of a threshold whether the rate of deflection is in an up-and-down 
threshold. Without changing a transit way, it shifts to the next scan and transit is 
continued in the same procedure. When it is judged as those with an obstruction, 
while the signal is memorized by the storage section of a computer, the directions 
which change a transit way are made. 

[0032] In addition, road surface datum-line BLK-q.n which replaced with the 
above-mentioned standard road surface datum line latest starting time, and was 
obtained by scan q times ago [ last time or ] if it was in this example It can also use. 
Moreover, in this example, it calculates to the 2nd step, and is road surface 
datum-line BLK.2. Road surface datum-line BLK.1 obtained by the 1st step 
although asked It may be made to judge the above-mentioned obstruction 
immediately. 

[0033] Next, what is necessary is to extract only all near [ fixed ] the road width with 
the transit schedule direction, or the distance data of some measure points in many 
cases, even if it does not use the distance data in all the measure points that are in 
a scanning zone among said distance data population A first when the 2nd still 



more rational example of this invention is explained referring to the flow of drawing 
5 , and the example of derivation of the road surface datum line at the time of 
obstruction detection. Then, distance comparison data ensemble E of the measure 
point in the fixed road width which has the transit schedule direction among said 
distance data population A in this example Road surface datum-line data ensemble 
CO of the measure point which extracts and is near [ which has the transit schedule 
direction among said distance data population A / fixed ] the road width further It is 
extracting. 

[0034] and road surface datum-line data ensemble CO near [ said ] the road width 
from - said distance data ensemble Cj (number of steps of the arbitration from j:1 
to n) extracted as mentioned above - being based - up to the n-th step - a data 
operation - repeating -- road surface datum-line BLK.j for every step computing - 
final road surface datum-line BLK.n It draws. Subsequently, said road surface 
datum-line BLK.n corresponding to the distance comparison data ensemble's E 
each distance data and each measure point of all measure points The upper 
distance value is compared by the comparator of an arithmetic unit, and the 
existence of an obstruction is judged. 

[0035] In addition, road surface datum-line BLK-q.n obtained by scan q times ago 
[ last time or ] in detection of the obstruction by the Kth scan It uses. Road surface 
datum-line BLK-q.n which determined the threshold of the upper and lower sides 
which extract the distance data ensemble Cj (number of steps of the arbitration 
from j:1 to n), or was obtained by scan q times ago [ last time or ] It uses, the 
threshold of the upper and lower sides of the comparator of an arithmetic unit is 
decided, and the existence of an obstruction can be detected. 
[0036] Next, above-mentioned road surface datum-line BLK.j As other technique of 
the derivation approach, he is the distance data ensemble Cj of the j-th step. It can 
be based and the line by which it was not concerned with the location of a measure 
point, but only the constant rate offset the semi- road surface datum line latest 
starting time set as the beginning of each scan can also be made into a road 
surface datum line. 

[0037] The amount of offset at this time (y) It decides by the degree type. 

y= {sigma (latest-starting-time.i-LK.i)}/num - here latest-starting-time.i : Distance 

value LK.i to the road surface corresponding to measure point i which can be found 



from the standard road surface datum line : Distance data ensemble Cj who is a 
measurement distance value in measure point i acquired by the Kth scan Element 
num : Distance data ensemble Cj Road surface datum-line BLK.j which is the 
number of distance data and which was computed by the above-mentioned 
technique The distance value corresponding to upper measure point i is decided by 
the degree type. 
BLK.j.i =latest-starting-time.i-y . 

[0038] Moreover, the above-mentioned distance data ensemble Cj It is based and 
let the line which changed the amount of offset and offset the standard road surface 
datum line latest starting time set as the beginning of each scan according to the 
location of a measure point be the road surface datum line. At this time, the amount 
of offset in measure point i is calculated by the degree type, 
y i =[sigma{(latest-starting-time.i-LK.i) /latest-starting-time.i}] 

xlatest-starting-time.i/num - here distance value LK.i to the road surface 
corresponding to measure point i which can be found from the 
latest-starting-time.kstandard road surface datum line : Distance data ensemble Cj 
who is a measurement distance value in measure point i acquired by the Kth scan 
Element num : Distance data ensemble Cj it is the number of distance data -- Road 
surface datum-line BLK.j computed by the above-mentioned technique The 
distance value corresponding to upper measure point i is decided by the degree 
type. 

BLK.j.i =latest-starting-time.i-yi . 

[0039] Furthermore, it is in this invention and is above-mentioned road surface 
datum-line BLK.j. As other technique of the derivation approach distance data 
ensemble Cj of the j-th step Road surface datum-line BLK-q.n which it was based 
and was computed by the scan q times ago [ last time or ] (eye a K-q time) 
[ whether the line which offset the amount of offset which was not concerned with 
the location of measure point i, but computed only the constant rate by the 
above-mentioned formula is made into the datum line and ] Or distance data 
ensemble Cj of the j-th step Road surface datum-line BLK-q.n which it was based 
and was computed by the scan q times ago [ last time or ] (eye a K-q time) The line 
which changed and offset the amount of offset computed by the above-mentioned 
formula according to the location of measure point i can also be made into the 



datum line. 

[0040] By the way, although it is usually enough to detect an obstruction transit on 
the street by the above-mentioned technique, when pitching and rolling of a transit 
car cannot be disregarded or it is going to secure a more exact detection precision, 
it is also possible to season coincidence with these conditions. Drawing 6 is road 
surface datum-line BLK.j drawn from pitch angle [ of said transit car ] theta, roll 
angle phi, and the ground in consideration of the height Hs to distance measuring 
equipment. It is shown. 

[0041] That is, it is road surface datum-line BLK.j about the straight line which 
replaces with measuring only the distance from the distance measuring equipment 
on the car mentioned already to a measure point, measures height Hs in airraid 
pitch angle [ of distance measuring equipment ] theta and/or roll angle phi, and a 
list, assumes a road surface to be a flat surface, and can be found from the 
geometric constraint shown in the intersection of this road surface and the scan 
layer of distance measuring equipment, i.e., drawing 6 . It can also derive by 
carrying out. In this case, in attaching in a car, or judging the existence of an 
obstruction based on height Hs in airraid pitch angle [ of the distance measuring 
equipment detected at the time of car transit ] theta and/or roll angle phi, and a list, 
as distance measuring equipment is shown in drawing 6 through a stabilizer, the 
need of amending the above-mentioned threshold beforehand set as the 
comparator may arise. 

[0042] Drawing 7 shows the range measurement mode from the transit car at the 
time of rolling. The difference of (distance value BLK.n.i corresponding to measure 
point i on the road surface datum line) to (measurement distance value LK.i to the 
point of said failure lifter) turns into deflection di so that he can understand also 
from this drawing. Height Hi of the obstruction at the time of rolling and pitching 
When the value of the rate of deflection separates from an up-and-down threshold 
as shown in drawing 7 since it understood that it is proportional to di/BLK.n.i (rate of 
deflection), it can be judged that there is an obstruction with the height which 
should be avoided. 

[0043] Moreover, also when there is a concavity which cannot be exceeded to a 
transit on the street according to this invention, it is possible to detect the concavity. 
Here, with the concavity which a car cannot exceed, it is dependent on the width of 



face W of a cavity. Drawing 8 shows the detection mode in case a concavity is in a 
transit on the street. Now, the car is running with the mean velocity of V and 
presupposes that the scan of the single dimension by distance measuring 
equipment was made K times. 

[0044] In order to detect the concavity which cannot be passed [ said ], when 
detecting as an obstruction of concave continuously and filling THLEN<Vxa/f in 
measure point i about all the scans from a scan a times ago (K-a time) to the Kth 
time, measure point i is judged to be the concavity in which **** is impossible, here 
- f - the scan rate (Hz) of distance measuring equipment, and THLEN - a 
threshold - it is - Vxa/f - the width of face W of a concavity - abbreviation - it is 
equal. 

[0045] All the above operations are performed by the arithmetic unit 14 as shown in 
drawing 9 . This arithmetic unit 14 is the distance data population A acquired with 
distance measuring equipment 11 inside to the road surface datum-line data 
ensemble CO. And the pretreatment section which extracts the distance 
comparison data ensemble E, said distance data population A or said road surface 
datum-line data ensemble CO from - the datum-line operation part which derives a 
road surface datum line - The comparator which judges the existence or 
nonexistence of an obstruction using the deflection or the rate of deflection 
computed from the road surface datum line drawn in this datum-line operation part, 
and each distance data of said distance data population A or the distance 
comparison data ensemble E, While receiving distance data from distance 
measuring equipment, it has the l/F section which transmits obstruction data (a 
direction, distance, height) to a car control apparatus, and the control section which 
controls data transmission and reception of this l/F section. 
[0046] Here, he is said road surface datum-line data ensemble CO. It is the data 
ensemble who consists of all distance data extracted from the distance data 
population A which is obtained by one scan of distance measuring equipment, and 
which is all distance data ensembles, or some distance data, and is road surface 
datum-line BLK.j of the j-th step. The data ensemble who is to the base when 
deriving is said. Moreover, said distance comparison data ensemble E is a data 
ensemble who consists of all that are in the predetermined road width of the transit 
schedule direction among all the distance data obtained by one scan of distance 



measuring equipment, or some distance data, and is a data ensemble employed 
when judging the existence or nonexistence of an obstruction in the 
above-mentioned comparator circuit. 

[0047] On the other hand, in the detection approach of the obstruction by this 
invention, the case where it is sufficient if various kinds of data processing is not 
performed as mentioned above but ** also presumes the existence of still easier 
data processing or an obstruction is also included. That is, he is the distance data 
ensemble C1 of the 1st step to the flow of the detection approach by the 1st and 
2nd examples of the above of an obstruction. Before extracting, he is the road 
surface datum-line data ensemble CO. When it uses, the existence of an 
obstruction is presumed and it is presumed that he has no obstruction, he is the 
distance data ensemble C1. The processing after an extract is omitted and an 
improvement of processing speed can be further aimed at by shifting to the next 
scan. 

[0048] Drawing 10 is the flow of the presumed approach of the 1st obstruction 
existence, and its road surface datum-line BLK.n. It is shown. The 
above-mentioned road surface datum-line data ensemble CO It sets, and if it is 
within the range with all differences dLi (=LK.i-p-LK.i) of the distance value between 
a ****** measure point (i-1, i) or the measure point of fixed spacing, it will be 
presumed that he has no obstruction. On the other hand, when what is not within 
the range exists, it is judged as those with an obstruction, and he is the distance 
data ensemble Cj of the 2nd example of the above. It shifts to extract processing. 
[0049] In this case, road surface datum-line data ensemble CO It can set, can have 
the ratio rLi (=LK.i-p / LK.i) of the distance value between an adjacent measure 
point or the point of fixed spacing, and the existence of an obstruction can also be 
presumed. Moreover, road surface datum-line data ensemble CO Difference of the 
detection distance between the measure point which sets and adjoins each other, 
or the measure point of fixed spacing dLi or (=LK.i-p-LK.i) ratio The ensemble who 
consists of rLi (=LK.i-p / LK.i) is constituted, and the existence of an obstruction is 
presumed by dispersion in these ensembles (standard deviation, distribution). 
Furthermore, two or more above-mentioned approaches may be combined, and 
data correction may be judged by the logical operation (an AND, OR). 
[0050] Drawing 1 1 shows the flow of the presumed approach of the existence of the 



2nd obstruction, and its road surface datum-line BLK.n. Before extracting the 
distance data ensemble C1 to the presumed approach of the 1st above-mentioned 
obstruction existence Road surface datum-line data ensemble CO Road surface 
datum-line BLK.O used and computed When it uses, the existence of an obstruction 
is presumed and it is presumed that he has no obstruction, the processing after an 
extract of the distance data ensemble C1 is omitted, and the improvement of 
processing speed is aimed at by shifting to the next scan. 

[0051] the road surface datum-line data ensemble CO and this road surface 
datum-line data ensemble CO who consist of all or a part of distance data 
population A which consists of all distance data of each measure point which 
measured with distance measuring equipment and was acquired from - road 
surface datum-line BLK.O computed by the above-mentioned technique 
Functionality is investigated, and when the functionality is high, it is presumed that 
he has no obstruction. On the other hand, when that is not right, it is judged as 
those with an obstruction, and he is the distance data ensemble Cj of said 2nd 
example. It shifts to extract processing. 

[0052] Moreover, there are the following methods other than technique of 
presuming the existence of the obstruction using the above-mentioned functionality. 
Said road surface datum-line BLK.O Deflection di (BLK.O.i-LK.i) of distance value 
BLK.O.i corresponding to upper measure point i, and measurement distance value 
LK.i (LK.i **E) in measure point i, Or it is distance value BLK.O.i about the deflection 
di. Rate diof deflection/BLK.O.i which **(ed) If it is within the predetermined range 
altogether, it will be presumed that he has no obstruction. On the other hand, when 
that is not right, it is judged as those with an obstruction, and he is the distance data 
ensemble Cj of said 2nd example. It shifts to extract processing. 
[0053] Furthermore, said road surface datum-line BLK.O Distance value BLK.O.i 
corresponding to upper measure point i The ensemble B3 who consists of 
deflection di (=BLK.0.i-LK.i) with measurement distance value LK.i (LK.i **E) in 
measure point i is constituted, and if it is below in a value with dispersion in this 
ensemble B3 (standard deviation, distribution), it will be presumed that he has no 
obstruction. On the other hand, when that is not right, it is judged as those with an 
obstruction, and he is the distance data ensemble Cj of said 2nd example. It shifts 
to the above-mentioned extract processing. 



[0054] Or said road surface datum-line BLK.O Distance value BLK.O.i 
corresponding to upper measure point i The deflection di (=BLK.0.i-LK.i) with 
measurement distance value LK.i (LK.i **E) in measure point i distance value 
BLK.O.i Rate di/BLKof deflection .O.i which **(ed) from » becoming ensemble B4 is 
constituted, and if it is below in a value with dispersion in this ensemble B4 
(standard deviation, distribution), it will be presumed that he has no obstruction. On 
the other hand, when that is not right, it is judged as those with an obstruction, and 
he is the distance data ensemble Cj of said 2nd example. It shifts to extract 
processing. Moreover, there is also an approach which combined two or more 
these presumed approaches. 

[0055] Furthermore, according to the detection approach not only concerning 
detection of the obstruction which exists on the ground but this invention, before 
arriving a mobile at the transit location of a detection car, since it is fully detectable, 
the detection approach of the obstruction in this invention can also detect the near 
location and the magnitude of a mobile, while a detection car runs. 
[0056] Drawing 12 shows typically the time of detection by the distance measuring 
equipment concerning this invention on the car to coming flying [ of a mobile ]. That 
is, a single dimension is made to scan distance measuring equipment 11 with the 
predetermined inclination theta, as shown in this drawing. Supposing the range 
measurement limit by said distance measuring equipment 11, for example, a laser 
distance sensor, is 300m, using the rate of the mobile 120 here as 300 m/sec If less 
than 50 msecs120, for example, a mobile, are a missile, the processing speed 
which measures with distance measuring equipment 11, and is taken to discover 
From the ability to make within 20 msecs, time amount after discovering until an 
interception command is emitted and intercepts (50msec+20msec) It is possible for 
it to be set to x300 m/sec(= 21m) <300m, and to cope with it to coming flying [ of 
said mobile 120 ] with sufficient allowances. 

[0057] Drawing 13 is a mimetic diagram in case the distance measuring equipment 
1 1 of this invention detects the near velocity vector (a rate, the flight direction) of 
said mobile 120. An inclination theta 1 which according to this example uses said 
distance measuring equipment 1 1-1 and 2 sets of 1 1-2 so that it may illustrate, and 
is different in each And it is made to scan in single dimension with theta 2 (thetal 
<theta2). Inclination theta 1 After the mobile 120 was detected by the distance 



measuring equipment 1 1-1 to scan, it is an inclination theta 2. It has and this mobile 
120 is detected by the distance measuring equipment 11-2 to scan. If alphal, 
alpha2, and the time difference of those are set to deltaT for both this distance 
measuring equipment 11-1, each distance measuring equipment 11-1 at the time of 
detection by 1 1-1 , and the detection include angle of the scanning direction of 11-1, 
it is possible although the near velocity vector (a rate, the flight direction) of a 
mobile 120 is detected from these values. 



DESCRIPTION OF DRAWINGS 



[Brief Description of the Drawings] 

[Drawing 1] It is the organization chart showing the example of a measurement 
device by the scan of the single dimension of the distance measuring equipment 
using the typical laser beam of the obstruction detection approach of this invention. 
[Drawing 2] It is the whole perspective view showing typically the mode at the time 
of the range measurement by this invention approach. 

[Drawing 3] It is the flow Fig. showing the procedure of the fundamental detection 
approach by the 1st example of this invention. 

[Drawing 4] It is the explanatory view of the road surface datum line and an 
obstruction detection condition obtained according to the flow of drawing 3 . 
[Drawing 5] It is the explanatory view of the fundamental detection flow by the 2nd 
example of this invention, the road surface datum line obtained by that cause, and 
an obstruction detection condition. 

[Drawing 6] It is the calculation explanatory view of the road surface datum line 
when making the roll angle, pitch angle, and height of distance measuring 
equipment into a measuring element. 

[Drawing 7] It is the explanatory view showing typically the rolling condition and the 
detection mode at the time of a car. 

[Drawing 8] It is the explanatory view showing typically the detection mode of this 
cavity in case a cavity exists ahead. 

[Drawing 9] It is the explanatory view of the arithmetic unit for making automatically 
various kinds of data processing in the obstruction detection approach of this 
invention. 



[Drawing 10] It is the explanatory view of the flow which shows the 1st example of 
the existence-or-nonexistence presumption approach of the obstruction of this 
invention, the road surface datum line obtained by that cause, and an obstruction 
detection condition. 

[Drawing 11] It is the explanatory view of the flow which shows the 2nd example of 
the existence-or-nonexistence presumption approach of the obstruction of this 
invention, the road surface datum line obtained by that cause, and an obstruction 
detection condition. 

[Drawing 12] It is the conceptual diagram of the detection mode of the mobile by the 
distance measuring equipment concerning this invention. 

[Drawing 13] It is the conceptual diagram of other detection modes of the mobile by 
the distance measuring equipment concerning this invention. 
[Drawing 14] It is the organization chart showing the example of a measurement 
device which shows the mode of the scan by the laser distance measuring 
equipment of the conventional 2-dimensional scan. 

[Drawing 15] It is the calculation explanatory view of distance measuring equipment 
and the measure point location which becomes settled according to the geometric 
constraint of a measure point. 
[Description of Notations] 

1 Laser Oscillation Machine 

2 Half Mirror 

3 Rotating Polygon 
10 Car 

11,11-1,11-2 Distance measuring equipment 

12 Obstruction 

13 Laser Beam 

14 Arithmetic Unit 

100 Laser Oscillation Machine 

101 Rotating Polygon 

102 Galvanomirror 
120 Mobile 

theta Pitch angle of a measuring device (inclination) 
alpha Measurement vectorial angle 



phi Roll angle 

K The count of a scan 

j The operation number of steps for every scan 
Hs Height of a measuring device 
L Measurement distance 

LK.i Measurement distance in measure point i acquired by the Kth scan 
A Distance data population 

E He is a distance data ensemble (E**A) in a setting range beforehand. 

Co He is a distance data ensemble in a setting range (Co **A) beforehand. 

Cj Distance data ensemble of the j-th step 

latest starting time Standard road surface datum line 

BLK.j The road surface datum line of the j-th step of the Kth scan 

latest-starting-time.i Distance value corresponding to measure point i which can be 

found from the standard road surface datum line 

BLK.j. i Distance value corresponding to measure point i on the road surface datum 

line of the j-th step of the Kth scan 

num Distance data ensemble Cj The number of data 

W Width of face of a cavity 

V Mean velocity of a car 

f The scan rate of distance measuring equipment 

The count of a scan continuously detected as an obstruction of concave 

th Inclination over a measure point 

alp Vectorial angle over a measure point 
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©^m^a 0 

7 ] f§ j Xf >y 5 MIBEgSI-r- ^ * 

fflCj (j : l^e»n*Tf©ffi3i©^ry^S) ©tttti 

b l K- q .n t q ®m<D7£M~en fcKatr- ^ t * y 

54-0 (K[H@) ©^SKiSMfBEglx-^e^fflA 

XtiESffiS«§-r-£ jfcffl Co ©*»JS*>T > h 

■T § SgUr- ^ *«HH"r 5 c C * 0 fr 3 2 Xti 

3 i3«©^«ti©^m??ffio 

[ft** 8] 't&KHfc7C-ej££Lfc«H*}*»©16« 
fc^JU *««{cfeltS7 i -*l*ai©PBffl©lt*S* 
6^5iil*^6Xtt 7 Eig©^%©^W^o 

9 ] ^ j ^ f- v ?Ki3if 3 mibshx- if m 

HCj (j : l^n^OtttOXfy^ft) ©JftHJ 

*w*« 4-7 ©i^n^Kia«©aw^©fi*^ i b 

■ftfc £ 0 If 3 jtfr K±©K^ti©^ai^rS 0 

0] s j Xf-v^eftttsiWBttffiiPWiB 

Lk.j (j : lA^nlWfilOXf'^lt) ^ 
WSsP W > h CT k ©SBUr- ^ *#> SSSffiS"*^ B L 
K.j i;©<iMdi ©*6^i[©m*©^l*«^i:1"S<fc 

3 tcwm ltrs-t umm i ~ 3 ©v^-r na»WE«© 
^w^©^tii73?io 

[W*^ l UJjXfy BfflBSSffiS'*» B 
Lk.j (j : l*»6n*T?©ffi3Bt©^'r'y^lR) iJ 
S>t°-T y h ©fittfclB^ 6f MIB^*SSffiS*«S Lst 

oas-r§ii*^ 1 ~ 3 ©^-f ns^EK©!***©* 
mm* 
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ift^ icMtmm&mmmm l st # e, ms© 

IE«©l««ti©^ai?m 

c»*« 13] $ j x f - >y 7°(c fci f z> mmmwmm B 

Lkj (j : lfre>n%t:(DttM<DZf-V7m £:> &I 



Lk.j (j : lA^nST'OftlCXr'y/'a) £\ SI 
h -p T^" 7-tr >y h LTf#P>n5^ LTSHi-r ^> 

Mm i ~ 3 ©i^-rn*^KiB«©i»»i»ottffiy3ffio 

[|t*a 1 5] IjXf'V 7 *5tt § BUlBSSffiS W B 

Lk.j (j : lfren*^©ftiW);*-fy7») «V. 

ti5E*-e»5i»*3a i ~3 ©v^-f n*^8a«©»#» 
[»*js 1 6 ] mmww>m&-t:& o , i rxs 

(c £ o stf- * ©-auc wmnwmr- * ©#&# 

>yyj - l EfcitSBffllSqiiBfcjltfi-rsci:, 

[0 0 0 l] 



10 



20 



30 



40 



[0 0 0 2] 

[0 0 0 3] WTC» l^—tf^-^TC^^^^TI^ 

—»f)t (3MM>t) ^ ®m&mmi o i t*wv$7 

[0 0 0 4] Sffi±fr6>> c©iiJS%!f*5di:-r§iit 



[0 0 0 5] HKKfflKffiftiftBfcfM-rSfctt, 0 1 
5 (cfc'V^T#»JS4-°-r y h ©ftS (fug : X, Y, Z ) 

(ffl^^-Yy tK.tit&ti&l t hV a 1 p, 

(x, y, z) a, mmwyf-vfRxfv—vy?® 

tc&vmbWv'f-y?* o-u y>f%izyi/yyu 
fu«r- ^ *mmm- ®-tr > ■9-* 'J y> 

(**lHE(t)-*S<tS, ©hWF 
(HSg) £j£<-fSs ®^-/l^-xatfhU>y F© 

[0 0 0 6] 
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[0007] fot, xmiosmz. ifflfitje&^fitt 

[0 00 8] 

%0*ffrftei\ KiB±K:u—»f^t»L< tiffins, 5 
U &*-*7Cfc:j£SE bfcjtf 6» > -|sl<Dj£2E eTfcK::*iW> 
Mff fc^ £ 5 *j£ffB±o»««©»S**fflt 

[0 0 0 9] ffi$£ 1 1^§^{±, j£fr*5¥ffi±fc: 

0(?)iSi:^ ©^a»^ y h vmmr- $ mmm a & 
fflci zmmtzzt., mm-£tirztffiEsm ; r~si*m 

7-££> ^o&SJ^tf'f > hfc*fJ&rs£ j - lXf 
yyoMMW&BB Lk.j-i (j : 2^e>St r -©Xf- > y 

fflCj (j : 2*^n*"e<DX"fy^tS) ©K8tx-£ 
fc*3*8jXrv:/0BiB»P«BLi.j *S*«J> 

LT*»WfcBiBa!ftRBLi,n *»W*mgl5(CT!* 40 

bTj£frlS±©»Sftl*tfttfiU &@WHW>j£Sfc:»fT 
£©fln?t>«fc < > SWi^OtffcffiE-tS&Ba^Ufc 
[0 0 10] ?%t>%s j6fftS*S±*»6-— *7cWfc 



- * © 9 13 ^ p. 3f S©r - * . fcfflffi L TSSffiS* Itx- 
Sgilr-^tcS^t^ 1 Xx>y7©SSffl»P»§:«tti 

h Ktt jSt ^ IgKH * Jtlfc U ^OJtlSHBtfBHi©* 
g©^«Bfr5&aTfflfflbTffil«T-2&BiC2 £ 

[001 1 ] 2 tc&tzftmtt. m&m 1 

& § £T t> L < {i-»©E(tr - * ffi b TBffiS* 

^•-^miaco A^ftmbfcffiftT f -^*fflCj (j : 
iaessfcTfts-rscfcx it«ni»K:Tit«-tsis 

[0012] c©SKBK«fcntf, ucfcw-sffiffi 

SipSSx— ^^fflCj (j : l*^n$T*OXf77 
8gSr-^^ttmbTSg»bK-r-^*fflEi:L, 

But aSSfflSV^x- ^ ilffl C 0 . K jBSiplST*- Z-M 
fflCj (j : 1 frP.nfT'©Xf7yS) .*»tM"*fc 

^*ffl E ©^T©te»r-^ *±IBta.SSHOJt«»K 
Tjrb^-T^^tOfflSx-^^bTV^o Ctltt, it« 

[0 0 13] 81*^3 fC^SSSWti, *ufB^»gg©Jt 



(5) 



i&ffl 2 0 0 0 - 7 5 0 3 2 



ytctetJSWaEEd-r-^jftfflCj (j : l^Sntf 

HAXttlSiBSip»r--*JfcfflCo ©SMStfi' > 
SBHx- * i: MIE1S'¥li§BS3igi L st ±©*f JS* 5 Sggi 

r- ^ ^am-T § C i: tc j; 0 tf a o 
[0 0 15] H*«5fcffSKWti, I jXf'y^tt" 
ItSMIBffiltr-^^Cj (J : 1 fr& n $T*©ffig 

<fc <o m t>fttc&mmmm b l ij- tcs-^t, tftgESK 

$4 y h cDSggEr-* £MtSS&ffl*«i B L k.j-s ±<o 

CO 0 l 6] tt*«6tc{£3f§0mi;, Hj Xf7/Kfi 
ItSMIBSgilx-^maCj (j : lfr6n£T*<Dffii 

«fco»w*nfcKffia!piSBLi-,.n' ts-^t, tMES 

[0 0 17] VURm7 fctozmu^ $ j TsTyftcto 

lt«W3BEIt7*-^*aCj (j : lfr?>nl;T*<DffiI 

K<kDJ!ca«nfeKffiaip|jiBLK.q.n £ q mM©jiS 

iBis«ix-^«*ffl hximmimT-zM® e ©&»j 

[0 0 18] W#St8Kflte8l»{;i\ fulEII** 6 X« 

7 lcfcMWlc&^>T. fufE-^T^SL/ciEB^ffi 

SSWCkatWEEHr-^jllHICj (j : l^n 
STOttlOXf y^S) <DttHJ*BI*«4~7©V^ 

[0 0 19] M^gi o~M#*i 5ti, ±3B»fflSiP 

IBLk.j (j : lfr6>n$T'©ffi&<E>Xr>y7 , &) <D 
Sffi#7£;§:*l£LT:j3<X tmMm 1 0 fC^ISWC&o 
Ttt, JgjXT'y^fctfSMeBSgffiSWlBL 
K.j (j : l^enSTOttltOXry^Bc) 



L st 6 -SS^tf* 7 -fey h L/cSi: LTfftti 

[0 0 2 0] M$gl 2tc«3fgi^ mj Xr 
*y7*fcfettSWEISffiSJMlBLii.j (j : lfr5>n£ 

7 -try h bxm^n^Bt Ltftt)t§fe<Dt$5„ 
10 [00 2 1] mMm 1 3 RtfH^ l 4 K:fl&9ftg& 
MfESSfflSW B L k.j (j : i^6nST?Offilt©X 

tr) ©3t4f«:«fc»)lWl*tifeWIBB®aSJWiB Li-,.n 
*^FJfS<D^7-b-y hMt-3t*7-lr7 b UfeSltU 

[0 0 2 2] ffi$gl 5 fcffiSISWB:. _h»l,fcJ:5fc 
20 *H±OE)tjllSSlI*^iB!l^4?i' > b S •eoffillO* 

TiWS^*feOT**0, HfffES§ffi**»BLK.j (j : 

[0023] fiLto*ffii**», i&±icfttet zmmvn 

-3 T*W#fg 1 Rtf ^ 2 <DM!EIEB^?IJ«gg«:# LT*5 

7cWfc c i:> » l Rt>*^ 2 ©^SggtW^ga 
0**«f{c WIEtfcRlHlBfc <fc 0 E(tr - * <D-g|»cFs^ii 

[0 0 2 4] 1**IR1 7^^^^, ±^cD<r'i:<- 
@©^ScDfctf fCX-r -y 7S n % t> o TJgHx- ^ Ott 

f - >y 7g co^^-r- Z ©tttB ii -r- ^ MUlc i D f# p> ti 
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[0 0 2 5] tftt>%, ^T-T5$ffi±tcSB$nfcSg 
»J^a%-^7uW(cx^-v> t, -BOX 

* * y <r t ic-zmmx ■< y v <oe*t- * sua a x« 

i&ttm-rSCfc, Xx<y7j fcfeltSilttr-^fcBIC 10 
[0 0 2 6] 

JKTfc:»tWtS«l:3l«:j£fiK±f«:*5l»»«j*tfta , t 

[0027] H2ti N *wi oicmmLrcmmm^s 

1 lfC«tSjiff«f©l»*fWfttiJOfllfll%l«*tTV^o 

0. 8IMJ£SBl lfr&OU— 3 ? 
7-ry±{C^4LTV^^©SJS^-Oh i ©figfC 

[0 0 2 8] viu E^c^-tJ^fc^frt 0 
±£Rl!SnfcM!l£Sll 1 l *-:&7Ef<:j£2£3-&, 

gsg»a Liu hiEMZb \crniiic.wfe-&n%igmm 
a*PfiLsr±o»^>r>Hi:WK-rsffiiifflLsT.i t 

©IBM (Lsi.i -L1.1 ) *JW1U IWIfSTHL 

1. THH 1 0«Hrt£fc*iEli7*-**i*tfi'rsci: 
fc*0fr5o c©^> HufH^SKSBUfiLK i iiSgfi 



10 

atom o^DitM^w^^mca^twc* 

THL2^ (Lsi.i -Liu ) /Lsr.i ^THH 2 

THL2ttT«Kfi. THH2tt±IIIH(|iT** 

[0029] ccD&oicLxmzftrcmMT-zMSc 

[0 0 3 0] 3fcK» C©Bffi®PHB Liu *±£WP 
tc M£« > h i ic $3 it 5 MSSSSf ft LK.t £ MtBBffl 

ffiS**BLi.2 £*J6S<= CO}SIWW¥*aiHl (n 
El) H^MU ^n7x'y7©»$IW&Bafi"*fM§B L 

fcBffifflMiBLi.z 5i*fLT^5„ 
[0 0 3 1] cO»1WBLk.2 fC, 

tt^#aiJ^Sg»iLK.i tO££ft£¥ffi B Lk.2 ± 
***** ^Offifg^fcUiTOPIWrtK^SfrSfrfcit 

£ ¥ ijffi L i: t It. %<Dm W ^ ^ £ ^ — * ©SMS*: 

[0 0 3 2] ^43, *^Sfi0»C*oT«^ ±IE1f;*Bffi 
Lst (cf^x.Ts M@Xl± q @ffl<D jfeSfc <fc D l# 6) 
nfeBffiSJWBB LK- q .n *ffi-5Cfc.fP#S 0 ^/c. 

*mmm?&m 2 xf >y 7* -e** ltbss^ b l 

1.2 %M£>fct>\ mi Xr-y:/{cJ;i5f#P>nfcBfflS"¥ 

[0 0 3 3] 35?C, *«W©H{c^aW*» 2 *6S0!I* 
0 5 (07 D-Rtf l»*1*feaB$©Bi5»P«Oliaie!l* 
#P. h-D-offlm 5 i: , ^f" futasgltr- ^«*ffl A cd 
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HE *«MJU £?>tc, tuIESgiltx-^jflHA©? 

[0 0 3 43 *UT, WI3»IBfifif©KiifaePWr-^ 
ZMmCj (j : l^P.nft<DMdXf7yi) fc 

SiSqs«BLi.n KltltRr-^ io 

HHI E flD^WJEaJ?^ y V ©fcEKr- * £ 
^>ht»lS1-?.BuIHSSffiS^BLK.„ ±©SB»iti: 
^»IRS*©ltl!ffl|5»cTJtK«n, »*«j©*f9*!fL* 

[0 0 3 53 K|IIB©;£Sic£3l»*tt©tfctfifc: 

fefcO^ M@X&±q®M©^£fc<fcD#&ftfc&tga*P 
^BLK- q .„ E*7*-**fflCj (j : 1^5. 

n$T*©ffii©XT>y72&) %aa"r5±T©BBi(*ft 

«>fc!K q 0iu©£S£ nfcSSffiS* 

iBLi,.» *ffi-pTiSSSB©J±«SP©±"F©BBffl% 20 

'So 

[0 0 3 6] ±S»ffiSJPHB Lk.j ©#til73ffi 

©ffl©#Si:bT{4; ijXff^'Oiif-i'IfflC 

j fcatJvr, #^E©a*jf«:i8^5nsi?iBffli»ws 

[0 0 3 7] d©tt©^7-fe-y h«( y ) H\ 2eSfc 

y= {Z (Lst.i — Lk.i ) } /num 30 

Lsr.i : W$&mW*mfrlbi*.te.ZWfc#'<yY i £ 
WlSt?.S§ffi$T©SBSIfi 

Lk.i : KMUcDHeMlc&vmWLrcfflfetfJyh i 

£ fcij § ijssggifi-efe § ffiSix- £ jfcffl c j ©sn 

num : SgKx-^ilfflCj ©KHx-^SSc 

±E#SlcT3?tHLfeBSffiSlpjaBLi.j ±©SI 

B Lk.j.i = Lst.i — y 

o 40 

[0 0 3 8] $fc, ±12SEitr-^*fflCj fcg-3V 

y i = [Z { (Lst.i —Lk.i ) /Lst.i } ] X Lst.i 
/ num 

Lst.i : aWBSSiPttfr 5$£ SiiS^-r > h i t» 



Lk.i : K HI g ©^Stc <fc 0 Hstf# L fe»Ji#-r > h i K 
fctt3SIIS£*frc*&3E*r-*a^lCj ©giS 
num : Klir-^SaCj ©E*r-*» 

fcfe, ±K^ffitTSttiLfcSSffi*WB Lk.j ±©91 
B Lk.j.i = Lst.i — y i 

o 

[0 0 3 9] MK, *^tCfe-pT±IBS§ffiS'WB L 

k.j ©*ffi#ffi©flS©#i£i:LTfcJ:, SB j Xry7*©E 

fftx-^jfcfflCj KlS-^T, WHXtt q @tu (K-q 
0g) ©^STStHtfcKffiS^B LK-q.n 3\ SJ£ 

tHbfc:*7-fe>y hm%*7-kv hLrm^M'mmtt^ 
f)\ ftv>U:£ j Xf>y 7©ffi«r-^*fflCj 

T, MH1X« q Hltu (K-q HIS) ©j£4T^tBb/cg§ 
ffi»*PSSB LK- q .n -ai^^yh i ©(MWyfiUT 
JJBSfc £t>»trjbfc*7-try ha*SSLT*7-fey 

[0 0 4 0] i;C3T\ «i±IB#ffi^T^ffSS±© 
l»#8j£fctil'$" § c i: Tf-H^T** * j£fr¥W© K -y 

tfcaf*S*«ffib.fc?fc"f3*£fc:f;^ <:ftS©*ft£ 

©e>y ^ 0 , P-;l/ft <p RXfi&±frhmMmZ%iW% 
t-OS$H s£#MbT#W£ft3S§ffi®fM®B Lk.j 

[0 0 4 1] tafr-fc, HiELfe*PI±©EK9J®Bli 
t\ lEfiilSgfi©*^^ ft eRtf/Xtto-^ 
^©KffiilKiiffl^H©^*®^©^ o$DE6 

Lk.j fcLTHWfSClfcfeTtSo £©*§£, MIJ 

ssa%x^if7>r"»f^bT*ffic«io#itfct), '« 
aBfc^ata^ ft t v ^ s ±t aMffi^ffi ie-t s £ 

b§di;fefe?>o 

[0042] 07tiP-U> / ^W©^T*W^ 6 ©E* 

k.„. i ) frp. (Mtsi^* ! l%±©^s-e©?iJSSB»aL 

K.i ) ©M&lHMd i t*<5^ a-'Jy»^^> 

^B#(C:fctf3I^S*©iS£Hi (i, di/BL 
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[0 0 4 4] flfeB3Iii*«ftffi^£l*UJ , fSfi:Hu M 

y h i fc&l^T a EIhu (K-a@) (DjEMfrZ K 
LT*fflU frOTHLEN<VXa/f*»ftti^ 10 
CCT, fttEKi»£»B<Dj£SU-h (Hz) , TH 

l e NtiHfi-efeo, v x a / f itm^iDmmcv&m 

bV\, 

[0 0 4 5] ^<D»»i£TH9fc^J:5ftSJI£ 
S l 4 fc £ K> iJt>n%> 0 c OMWSH 1 4 tt, rtgfllc, 
EgitfflSUB 1 l K «t t) «i# b ffiHr- * Slfcffl A 
6> BHBSJpfUr- * Affl C 0 R tflEWtRr - * *H E 

sgffi»Sx-^*iaco ^p.ssss?p^#ffl-rs8 20 

MIBEIEt- £ mmm A XttEltttRr- £*ffl E <D& 

x-* WGk Efe *2Hg"tSl/Fi5» JSCS 
m I / F 95(07*- * 3M§{8£ n y h p f 5 a y h d 

[0 0 4 6] llT% MIES§ffiSWr-^*HICo 

mmm^mm(DiM<D^mzx<on^n^x(Dm 30 

Six- £ SHTfe 3 B«7*- ^ftlfcffl A ?>am^ ftfc 
T^ot, J Xr-y7©S&ffi»M£B Lk.j Zmtti? 
gtJti&x-^liffl E ii ti, ■ SgSIW^SB© 1 
OBMBft E * « £TXtt-«5 ©E*r - * 6 ft 3 7*- 

[00 4 7] -73 % *f§BJ!E J; § R S»©tftai7j £K 40 

±Mic0cfc7tbT§s^7 i -^5aa^fT^-ri:ts 

«S0 5«^*t>a#bTl^S„ -rftfc-s, BS*©± 
IBS l Rtft§ 2 ^fitMlc «fc;5ttffl73ffi©7n-{;:**u 
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07D-Rtf-?"08S®S^B Lk. n *iLT^5. ± 

y b ( i - l , i)Sb< tt-£HHi©SI£j|?^ > h ffl 

<D!ElHI©MdLi (=Lk. i- P -Lk.i ) tf£T&3 

u ±e»2*aswio®t7*-^ifcHiCj o»w«yiK: 

[0 0 4 9] C<Di§3\ MWf-^IfflCo (C*3 

i^t, K<9^7 b < te-fflmam-y 

bffl<D&Mfe<Dit r L i (=Lk.i- p / Lk.i ) ^rfec 
t b < «-^HPB©?|iJS^^ > h H©^tbSg8i©M d L 

i ( = Lk.i-p -Lk.i ) ^Wiit rLi(=LK.i- P / 
Lk., ) A>6ftS*BB**I^U Cti^<D^m<D\,th'0 

[0 0 5 0] 01 1 tiS 2 ©B#^©W»©it£73SO 
TStHbfcl^ffiSWB Lk o ^rflJfflbTB#tl©W* 

^«£b, pf*% "«b" tm%.Lrcm&ici*, sgstr 

[0 0 5 1] Sg»JSSBtcJ:OiJSbTKI#bfc^iJ 
g^-Y y h CiTCiif- * A 1 S> ft 3 Sgltr- ^S* 

ffl a <o£gp t, b < 5 ft § ssbs^p^t 1 - ^ *ffl 
mb/cssffiawB lk.o fc©ffliitt%an^ ^©fflw 

14A^v^tc«^ti«bi:«l^-r5o -7j> 

ft v^*&fctil»»KjW 0 kWW b, SulBS 2 HMdoSE 

Mr-^*fflCj oatHfflaKSPffrso 

[0 0 5 2] Sfc, ±EfflHltt*fflV^fe»*%©W«S% 
^B Lk.o i K^JtSfSIBtttBL 

K.o.i k«B6#^yHK*ttsai®e«iiLi.i (l 

K.i GE) i:<D{iMdi (B Lk. o.j -Lk.i ) . XH^r 
cDfigdi^SgSieB Lk.o.! T«bfcflM*di/ B Lk. 
o.i A^T/ff^lSH^rttCfetliiWS^ftb^ftS-r 
§ 0 -73, ^^TftV^fcttfit^WOfcWWU tu 

"^"■50 

[0 0 5 3] HUfBS§ffia*HB Lk.o ±©l»JS 

l^yhi fC^jC-rSEIHtB Lk. o.i tMS^-r^ h 
itefcfr3ffl£(E(il!Li-.i (Lk.i 6E) £<DM%d 
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u'co*aiB3©tf6o* ouppbm, %m 
v ttBfFUjw o fc mm l . mmrn 2 mmm^ se 

[0 0 5 4] l£ W±MI5SgffiS«g B Lk.o ±<7»# 
-fy h i fCftjE-rSEIiHB Lk.o. i tifl-fyh i 
KfetfSifll^EliftLi.i (Lk.i GE) ttDdMd i 

(=BLn.o.i - Lk.i ) £\ gKffiBLi.o.i T*B&L 
'fefflHspd i /B Lk.o.i fr5>&3*fflB 4%«^Ls 

colfflB4 0Kot eHPPffl^ #tt) 10 

Tt*nti»s»*bi:i(is-r5o —is. f^-p^f 

[0 0 5 5] Mfc, 

jiff * tcfcl&flaDfefc * * ©{ufi&tf* # « % fe ft ffi 

[0 0 5 6] 01 2 It, &W}tt.<Dm$ttCftt%Wn±<D 
?^ft{*l 2 0<Di§fi£3 0 Om/s e c £ LT, buIB 

se»jssbi u yiai-b^Kisiat 

fflSPSfifi 3 0 0 m-e&s fc-r 3 i:, Sg»J/£S« 1 1 

fcfcow-Mu ni.-r§$Ticst§MSiisti5 om 
s e cm wmmmwi 20^^-o^vhmf, 

(£2 0ms e c U(I*|-£&U#3 d tfrZ, 
(50msec + 20msec) X300m/sec( = 21m)<300m 
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